APPENDIX A 



% BEGINNING OF PSEUDO CODE 

5 % compute scale factor A, and time constants a, b from physical system 

% parameters 

A = Vmax * Kt / (Re * Rm + Kt * Kb) * 1 * k; 

10 pi = 1/Jm/Ie * (-le * Rm - Re * Jm + sqrt(Ie^2 * Rm^2 - 2 * Re * Rm * le * Jm 
+ Re^2 * Jm^2 - 4 * Kt * Kb * le * Jm)) / 2; 
p2 - 1/Jm/Ie * (-le * Rm - Re * Jm - sqrt(Ie^2 * Rm^2 - 2 * Re * Rm * le * Jm 
+ Re^2 * Jm^2 - 4 * Kt * Kb * le * Jm)) / 2; 

15 a = max(-p 1 ,-p2) 

b = min(-pl,-p2) 

% make initial guesses for step durations 

20 etl = 1; 

et2 = .005; 
et3 = 1; 



25 



% set maximum iteration count 



Nmax = 1000; 



for j = l:Nmax 

% save old values of step time intervals 
30 etSold = et3; 
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et2old = et2; 
etlold = etl; 



% iterate for switch times using fixed voltage level Vmax 

5 

et3 = -log(l .0 / 2.0 - exp(-etl * a) / 2 + exp(-et2 * a)) / a; 

et2 - l^ * log(2.0) + 3 * et3 - 1/b * log(2 * exp(l/A * b * X) * exp(et3 
* b) - sqrt( 4,0) * sqrt(exp(l/A * b * X)) * exp(et3 * b) * 
sqrt(exp(l/A * b * X)+exp(et3 * b)^2 - 2 * exp(et3 * b))); 
10 etl = - (-2 * A * et2 + 2 * A * et3 - X) / A; 

if norm([et3old - et3 et2old - et2 etlold - etl], inf) <= eps * 2 
break 

end 

15 if j==Nmax 

error(['error - failure to converge after \ num2str(Nmax)/ 
iterations']) 

end 
end 

20 

% round up pulse duration to nearest sample interval, 

% convert to intervals betv^een steps to make sure that voltage 

% requirements v^ill not increase (beyond Vmax). 

25 dtl=ceil((etl - et2) / dt) * dt; 

dt2=ceil((et2-et3)/dt)*dt; 
dt3=ceil((et3) / dt) * dt; 

etl23 = [etl,et2,et3] 
30 % convert back to total step duration. 
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etl = dtl + dt2 + dt3; 
et2 = dt2 + dt3; 
et3 = dt3; 

5 % In the following, the original constraints equations involving XFl, XF2, 

% and XF3 have been modified to include a variable voltage level applied 

at 

% each step (instead of the fixed maximum (+/-) Vmax). 
1 0 % The original equations for XF 1 , XF2, and XF3 follow: 

% XFi(tend) = VoFi(tte„d " to) - 2VoFi(te„d " ti) + 2VoFi(tend " ti) 
% XF2(tend) = VoF2(ttend-to)-2VoF2(te„d-tl) + 2VoFi(t^nd-t2) 

% XF3(tend) = VoFsCttend " to) - 2VoF2(tend " tl) + 2VoFi(tend " t2) 

15 % And the modified equation including adjustable relative levels of 

voltage 

% LI, L2 and L3 are: 

% XFi(tend) = LiVoFi(ttend " to) - L2VoFi(te„d - ti) + L3VoFi(te„d - tl) 
% XF2(te„d) = LiVoF2(ttend " to) - L2VoF2(tend " tl) + LaVoFiCtend - tz) 

20 % XF3(te„d) = LiVoF3(ttend-to)-L2VoF2(te„d-ti) + L3VoFi(tend-t2) 

% And the corresponding constraint equations are: 
% XFi(tend) = Finalpos 

% XF2(tend) = 0 
25 % XF3(tend) = 0 

% Where all of the times indicated have discrete values, e.g. 
corresponding to 

% the controller update rate. 

30 
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% It should be noted that after the digital switch times are fixed, the 
constraint 

% equations derived from the equations above form a linear set of 
equations in 

5 % the unknown relative voltage levels LI, L2 and L3 and any standard 

linear 

% method can be used to solve for the relative voltage levels. In the 
equations 

% for (LI, L2 and L3) that follow, the solution was obtained by algebraic 
10 % means (and are not particularly compact.) 

% compute new relative voltage step levels 
% LI, L2 and L3 are nominally assigned to "1 "-2" and "+2", 
respectively 

15 si = X * (exp(-et3 * b) * exp(-et2 * a) + exp(-et3 * a) + exp(-et2 *b ) -exp(-et2 
*b) * exp(-et3 * a) - exp(-et2 * a) - exp(-et3 *b )); 
s2 = 1 / (et2 * exp(-etl * b) * exp(-et3 * a) + exp(-et2 * b) * et3 * 

exp(-etl * a)- et2 * exp(-et3 * a) - et2 * exp(-etl * b) -et3 * 
exp(-etl * a) - exp(-et2 * b) * et3+exp(-et3 * b) * etl * exp(-et2 * 
20 a) + exp(-et3 * a) * etl + exp(-et2 * b) * etl - exp(-et2 * b) * etl * 

exp(-et3 * a) - etS * exp(-etl * b) * exp(-et2 * a) - exp(-et2 * a) * 
etl - exp(-et3 * b) * etl - exp(-et3 * b) * et2 * exp(-etl * a) + et3 * 

exp(-etl * b) + et2 * exp(-etl * a) + exp(-et3 * b) * et2 + et3 * 
exp(-et2 * a)) / A; 

25 

LI = si * s2; 



si = 1 / (et2 * exp(-etl * b) * exp(-et3 * a) + exp(-et2 * b) * et3 * 

exp(-etl * a) - et2 * exp(-et3 * a) - et2 * exp(-etl * b) - et3 * 
30 exp(-etl * a) - exp(-et2 * b) * et3 + exp(-et3 * b) * etl * 
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exp(-et2 * a) + exp(-et3 * a) * etl+exp(-et2 * b) * etl - 
exp(-et2 * b) * etl * exp(-et3 * a) - et3 * exp(-etl * b) * 
exp(-et2 * a) - exp(-et2 * a) * etl - exp(-et3 * b) * etl - exp(-et3 * 
b) * et2 * exp(-etl * a) + et3 * exp(-etl * b) + et2 * exp(-etl * a) + 
5 exp(-et3 *b ) * et2 + et3 * exp(-et2 * a)) * X; 

s2 = (exp(-et2 * b) * exp(-etl * a) - exp(-etl * a) - exp(-et2 * b) - 

exp(-etl * b) * exp(-et2 * a) + exp(-etl * b) + exp(-et2 * a)) / A; 
L3 = sl*s2; 



10 si = exp(-etl * a) - exp(-et3 * a) + exp(-et3 * b) - exp(-etl * b) - 

exp(-et3 * b) * exp(-etl * a) + exp(-etl * b) * exp(-et3 * a); 
s2 = X / (et2 * exp(-etl * b) * exp(-et3 * a) + exp(-et2 * b) * et3 * 

exp(-etl * a) - et2 * exp(-et3 * a) - et2 * exp(-etl * b) - et3 * 
exp(-etl * a) - exp(-et2 * b) * et3 + exp(-et3 * b) * etl * exp(-et2 * 
15 a) + exp(-et3 * a) * etl + exp(-et2 * b) * etl - exp(-et2 * b) * etl * exp(- 

et3 * a) - et3 * exp(-etl * b) * exp(-et2 *a ) - exp(-et2 * a) * etl-exp(-et3 * 
b) * etl - exp(-et3 * b) * et2 * exp(-etl * a) + et3 * 

exp(-etl * b) + et2 * exp(-etl * a) + exp(-et3 * b) * et2 + et3 * 
exp(-et2 * a)) / A; 

20 

L2= sl*s2; 



% convert accumulated voltage steps to sequential voltage level 
VI =Vmax*(Ll); 
25 V2 - Vmax * (LI + L2); 

V3 = Vmax * (LI + L2 + L3); 



% END OF PSEUDO CODE 
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APPENDIX B 



AREA .. SUM(I,A(I)) =E= 0; 

VELOCITY(VINDX) .. VEL(VINDX) =E= VSCALE * 
5 SUM(I$(ORD(I) LE ORD(VINDX)), A(I)); 

POSITION .. SUM(I,VEL(I)) =E= FINALPOS * SCALEFACT; 
VLIMITP(I) .. SUM(VINDX$(ORD(VINDX) LE ORD(I)),A(I- 
{0RD(VINDX)+1))*(V0LTS{VINDX)+KBACK*VSCALE)) 
=L= VOLTLIM; 

10 VLIMITN(I) .. SUM(VINDX$(ORD(VINDX) LE ORD(I)), A(I- 

(0RD(VINDX)+1))*(V0LTS(VINDX)+KBACK*VSCALE)) 
=G= -VOLTLIM 

% A(I) are the current commands at time T(I) spaced equally at time DT. 
15 % VOLTS(VINDX) is a table of voltages representing the unit pulse 

response to 

% a unit output in current command. VOLTLIM is the voltage limit at 
saturation. 
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APPENDIX C 



GOALPOS .. SUM(I,A(I)*MODELAA*DT) =E=FINALPOS; 

MODEl(ILAST) .. SUM{I,-A(I)*MODELAA*MODELb/(MODELb- 

MODELa)*(EXP(-MODELa*(T(ILAST)+DT-T(I))) 

-EXP(-MODELa*(T(ILAST)-T(I))))) =E= 0.0; 

MODE2(ILAST) .. SUM(I,A(I)*MODELAA*MODELa/(MODELb- 

MODELa)*(EXP(-MODELb*(T(ILAST)+DT-T(I))) 

-EXP(-MODELb*{T(ILAST)-T(I))))) =E= 0.0; 

DERIV1(J) .. 1000.0*SUM{I,A(I)*T(I)*EXP(ZETA(J)*W(J)*T(I))* 

SIN(WD(J)*T(I))) =E= 0.0 ; 

DERIV2(J) .. 1000.0*SUM(I,A(I)*T(I)*EXP(ZETA(J)*W(J)*T(I))* 
COS{WD(J)*T(I))) =E= 0.0 ; 

% MODELAA is the mechanical gain of the system, MODELb, and MODELa 
% are the two time constants of the system in radians. One time constant is 
% associated with the L/R rise time of the motor inductance and the other is 
% the mechanical time constant of the rigid system. The A(I) are the voltages % 
which need to be determined. The T(I) are the times for each of the A(I). 

% DT is the time spacing of the outputs. W(J) are the undamped flexible 
% modes, WD(J) are the damped flexible modes (in radians/s). 



United States Patent & Trademark Office 

Office of Initial Patent Examination - Scanning Division 




□ Page(s) ^of were not present 

for scanning. (Document title) 



□ Scanned copy is best available. 



